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(54) ENVIRONMENTAL MODEL PREPARING DEVICE 

(57) Abstract: 

PURPOSE: To provide an environmental model preparing 
device capable of easily obtaining the positional 
information within environments of object data such as a 
desk and a chair, etc., and shapes of large objects such 
as a ceiling, a wall and a pillar, etc., when an 
environmental model is prepared. 

CONSTITUTION: This device is composed of a 
three-dimensional attribute information input part 1 
measusing the three-dimensional attribute information on 
distance and shape surface attributes, etc., by using 
visual information from a television camera and an 
ultrasonic visual sensor, etc., an environmental model 
processing part 2 controlling the three-dimensional 
attribute information inputted in the three-dimensional 
attribute information input part 1 and forming the 
environmental model, a video preparation part 3 
preparing the artificial video of environments based on 
the model description stored in the environmental model 
processing part 2, an analysis part 4 verifying the 
description of the environmental model by comparing the 
artificial video preparation result of the video 
preparation part 3 and the visual information at the 
present location and an observation control part 5 



performing the input control of 
attribute information input part 1 . 
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1 

COS j*:7cSttffl«A*a6J: 0 A:^J nfc 3 ;*:7cS^fi9 

CO 3;*:7cJS14«?ffi*Si|)£-r-5 3:;*:7cJR<*«llA:^«Bt. 
o 3 ^!>:7cS141S^ A;'3gi5 J: 0 A:^ $ nfc 3 ^TcJSItlf 

oe>I«fl2J5£SBCD AXPjl5«6f^)«*S« i:*i-]t&<*.StT©Wft 
mE 3 ^():ia;Mfi-:1f ?gA:/3gB<fc 0 A:'3 Snfc 3 

b, ^miy'—S'ii^<^mizsfmr£mm=^7')v^f&m-^ 

J; 5 id, WSB3i*:7£MttfftffiA*«E©A:fJfli'JfP^ffft5 
KailflWSS d> 6ft S t &<f^mii-t&^W.=ey')^f^m 

mm, 

mjstm 4 } Mia 3 :*7cMtti»% a*i6B*^ 
;i(omisixt)mwcizjz<o\titsnt^mm^m^-^r^n^ 



(2) !^Ba¥7-1467 5 2 

2 

Mft ® left -5 J; 5 aiwit--5^fs&c;*ini ?£gtai-r ^® 

[JgBJCDSfflftiftBJl 
[0 0 0 1] 

iff-m-^^m.'^'f)\''{^^^'mzmt^, 

Co 0 0 21 

jttLTH. 3>tfii-^i/"57WiJ7X (BAT. CGt 
Vi'S) 055=-^'©J;5tcAra7><MS«lfC<l3fRLfcO, ^ 

[0 0 0 3] Ara«*ss^^x;us-MS6*ncf^pj(,-rs:«7* 

6rom^l^cDitB«5l^tc8liJ^L.ft^J-n«ft6fti'«, 
[0 0 0 4] xs^eo^«j-e«,' fll. « 

A-^f v'H >«cOi5|(;Sl^cofccr)At^ScES!3?n 

^<£PgiIICf^figLXift6«, Jltl&CD^tf-SmiKl*!© 
[0 0 0 5] b/j^b, «L-^^S-7-^cD/hSi*f^ife5^-^' 
[0 0 0 61 ^'feBEfS-r-S/idlC 

tt< 4" (oacoiSLM izisitmfj^nx v> *^ t ^» o 

fc. /Mi?:* ^ coJ!gi^i^'S:g1#ffi*<!e:>s tft s 
d n!£:«']j^r s t tt^ Aft s^:^ t -r -5. 

ixtt. a[|A|K 7^; h&^*b;£:1SD«8©fi9a[b*»82l8$ 
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(3) 

3 

[0 0 0 7] DiJ^^y h7&tKl#lBloT^5^«Ox— 

vi^So z<Drz^. cGy'-i^(D^o\zmm(ommys.m^ 
^mmmmf)^»£:-muiS'^^zmmx^tji^\ lo 

[0 0 0 8] 

[0 0 0 9] mi<DmmAt\^T}ts mm^coMik^^ 

^\z7 ^'^7s\^xii^mm(D^m.ti^x^ni^\ ^^y). c 20 

[0 0 10] ^2(Df^m^tvx\t. '^ibntL^f-^^ 
m\z. mm&'^^K>^i^^ti^\z\t.^(o^o\zmmTn 
\tt&:\,^'f}^h\^^^z.Lt^^i8.'^nuf)^-Dytz.t\z^^o ^ 

mm]-r^^^^i^myj^tix^'^^'&^<Dmn'^:^mm\<D^ 
ti. it^^m\ ^mmmm^^m^x\.^<rztb(Dmmi^ 
f}-^nrzy'-:$^\zniy> mmm m^m^^^^m-}) ^ 

X\f^1^t^^tL (A. El fes:"UsingOccupancy Grids for M 
obile Robot Perception and Nav igat ion", Computer, Vo 
1. 22. No. 6. pp 46-57(1989) ) • 

[0 0 11] \.tzt^r>Xs ^m<<D:f5W^\'^s m^'^^fiV 40 

stissi^. ±mnmioym\^^^mz%^z.t:ymmx 
[0 0 1 2] ^^7?. :^^mx\t. m.m.'ey'ju^f^fSi-r 
i^mnfkmmm^Kmzm^z.tLfj^x^^mm'e 

[0 0 13] 



!^BaV7- 1 46 7 5 2 

4 

i&^ntcmm'e'rJi^zmri^mmcoAx^i^ik^^Ff&'r^ 

[0 0 14] W.2<D^m(0mSt'ey^)]^if'1&&M\t. 

af}BtCgEti$n^c^:SL^:xJl'{cia':::^€?S«£cDAXe*«<& 
^m-^^^V^iiSiMh. e:<Z)*«jf^/$S50AXB*«tf^^ 

i^m\zmMy3im^'ey'jv^mj$.'f^<ko\z. mBs-^Tt 
m'\immx:h3(oxfi mm ^nys: o wmumntis^ ^ ^ 

[0 0 15] 

w ffl] %i(DW^(r>m^'^'T)vvf'^&mm,\z'o\^^xm 

m.w^^(on'n.'\-y^m-^^<Dn%mmL-^m^^x. m&s 

[0017] mm'^'T)V9m.%w. nuwas^Tcs-i^ifia 
A* se^ a:^ ^ n>t 3 'ATcmm'^mL t t-s^ibis^ n/i** 

[0 0 1 sY f^mi^ium^^ mm^m'ev'jmmmzm 

[0 0 19] mmm^. mummmm(oA:L^mr^f& 
j^^hm^i{LWX(Dnnmn^'itm'r^<zt\z^r)mm 

[0 0 2 0] mmmm^f)^. sij8B3;*:7u)StttgfflA:^85 
0Atimm^mjiOo 

[0 0 2 1] e:nicj;o. mnmn^Aior^tmx. 
-^(DmmMm^m^. i^m^si^omv^^mmizn 

[0 0 2 2] JJ5 2 W5BW«C0ll«^^Mm«@lCt)l/^T 
[0 0 2 3] 3J*:7ciStt1t^A:^SW> -r-l/t::^;^^. 
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(4) 

5 

[0 0 2 4] ^m'^y'ji^mmm^. mm^'Aytm^mm 
AiJ SB'S A* ^ nfc 3 :k7vm^^m Sll USift t xJU 

[0 0 2 5] f^i»VFis.mfi^^ mmmm=ey')mmmzB 

CO 0 2 6] mmm^. mm\&imi^&m<Dxxi&i»rFSSi 
mm iimffMfs-v(Dm^mm&itm-r^ t it j; os«s 

[0 0 2 7] mmmmuifi, a'^jcmmmmxtiuj^ir) 

[0 0 2 8] e:niZ.fcO. Sai1-*?^m#)<73*f©i:L 
[0 0 2 9] 

[^SSM] 20 

( m m m 1 ) sit, :^^m(omi<ommm^ 

[0 0 3 0] mi\t. S9i--E7';Wtfi£^m<^SlHS«)sK?:- 

^2. Q!^^i^^f»s3, mm^4, mmmm^sft^i^mi^ 
[0 0 3 1] 

3 j*:7cPtt«^A:^^ 1 \i. mm<o 3 ^7cJ&«-^^tfiiit 
5 X5- l':tiii«ia}0*|-^&-::JVt?£fT;^i'i. x-j- ;* 

;i'ii!ia«2'\j556ns, 
[0 0 3 2] mm.'ey-}mmM 

[0 0 3 3] ^3izmm=Ey'>i'im^2<D9m<r) 

[0 0 3 4] (X5"->-yi) 

^^*si?^ic*5Pj-^3^7C;^S7^-^tr, s-ATimvmm 

*S©3*3CjSS7=-5'^^ttU. 3j*:7&Hffi7=-^'e« 



i|#B8^7- 1 4 6 7 5 2 

6 

38LTt5<. 

[00 3 5]® JggTffl56«, 3^7cS«£x-^'l5i8gB 
7fc?il9SnTV»-5^«[©3^?^«*#RgU. ;^COiii 

miRM^m^^'^-i'^.. ^(om-^iz. iii«iR^e:isti3 

[0 0 3 6] ® SMMffllgBStt. ilO[)fii:1g|cS«Et7^ 

^. 

[0 0 3 71 ® Ji«E^:7^JHl2^£^Bco«^llia, 3J*:7C 
K#fi«A:/jgS 1 C®«!A;(jft^^£jto. 

[00 3 8]® 3 ^kTtm^mmxijf^ l ^ 
u \zmpL^nt:imm^^nzf, Wfinumta^^a^w^o 

[0 0 3 9] ® :i<DSEmm^msim6\tmm&m^-v 

PB"5^:K^Ji(CE^ofe6**&T- (occupancy grid 04 

#M) Jc;feViT3;^s:7c^^!Kt«ffi7^-^!0'««»^Fn;fc^ 

[0 0 4 0] ® -ZO^Wl. :^y^U^mmXi3, SJfcTC 
[0 04 1] (X7-y:f2) mmmnit. =f'et)S^^i^y' 

[0 0 4 2] <D MSl%5r-^IBiitSi51 OICiHttSnT 
[0 0 4 3] (1) nV^'T-^ 

m^m'T~:5'(omm^^Mm<o/'^'y^izmK)-im. m-^ 
)Vf)^mm-^nx\^^^. m^m\^n^<ii3y'-^<ommizii 

mzMibi,. 
[0 0 4 4] (2) mWly'—i' 

ry'j'izMiii-t^Mmmr—s'^mcommK 
=.f^)^nv^±.vzT-i77.'^^—-7v\±>ifv-cwSLzn 

[0 0 4 5] (3) m-^^—^ 

\z'&;^nx\f'>u^^=nmny^(om^\t.&m\z'^^n^ 
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7 

[0 0 4 61® ^^^8T«. 3:;*:7clgtS^-^H2tS 
Ugh ^SSfflL. ¥ffi!(^>*^^^«i6So 

[0 0 4 7] U-r*y:/3) S^SBSTl^. S 1 O^F 
0y, ez) . JStZS^n^mm (dx, dy. dz) ^ 
[0 0 4 8] (T.^y'fA) 5^^1135 9 

^t^^u 1 0 {csffl^nxi.^^ 3:k7timvtiSLZf^m'r- 
[0 0 4 9] -^'fsitD-^. M^my'-^^mM^x^u. m 

jSi^mkuxm-^-r^o 

[0 0 5 0] (7s9-y:/s) m-^^tiftsn^/'^y^lBL 
mit^x^HBISgB 1 1 iC'SSf -So 

[0 0 5 1] efe^ll^jsas 

[0 0 5 2] ^ ^ gg 
ffii«f SB 4 1^, d 0) AXHjfeffe i: 3 'ArcmV^MnXfJ^ 1 

0. 3:*7ctfl£BttA*0^^. ^Mt::ci:-^Idjzli(?5^0fiB^> 

^jKtBb, Si^^:5=^;l/Ji43ffig|J2lCfeiN^$nfc^i^^xJl- 

3t7^ffi8llHt*=&3^7clStt1tS3A*SI51, *:^«. S8« 
[0 0 5 3] y^mmMX\t. sSiaSBSICiSViT. S^^^yc 



(5) #BB¥7- 1 46 7 5 2 

noCtti?^<. ^Si«R8lc:fel<:iTt6n-5SSai#j£tC 

[0054] (^JEW 2 ) ^ir. *^W<^^ 
it^:x;Wfr-lfiSB^a5 2 (D^JS^J^ia 1 Xt/ia 5 -la 1 

[0 0 5 5] :^mmm<omm'ey')]yi^&mm<Dmmm& 

10 fl. ^.l<D^JS^ja:(Rll^^<^T. • 3^7nSttfS«A-ASR 

1, ®iS[t7'ji/iiii?iia5 2, ^vifefp/seB3. ^«Tes4. li 

[0 0 5 6] 3:^7C«tt1faiAjjgg 

[0 0 5 7] 2-&C0-^Uli:^;^v 1 0 6. 1 0 7tt®ffilJ 

«ir#fiB5 .koMe>nT< -5^l^^!A;^J«^t^^J:DMfil*Rl 

l^fCA*U, inS»:?<^U 1 0 8. 1 0 9 's-^tl^n^S!! 
a? -r^o ^fir^^WffM 1 0l^Pi^;^^U 1 0 8. 109 
J; D A* ^ n?t 2 i6L<Dmmii^ €) X-Ir U'::rffilC<fc D^ff ^ 

[0 0 5 8] :^mmz^^mM^nf^o\m\z,. afmW 
[0 0 5 9] ^mi^t^^i 1 1 m^mm^s^y)m 

ffll^ *fT-^Sm6M 1 Olzi:OSUJ^n;tllf=r^x- 

^C\Z^^Vy^^Wi'SLlf:f5^^ (XV . yv , zv ) . 
V tb, ^fT#»mffll I 0l3j:i:5^6n/t5lff#x- 

gS.LN'x$illta)l*-rftK?:ffl^'»Tv>^) ^ (xs . ys 

, zs ) trsi, j;ATco:zrfi!s:icj;D. ia«£ffis» 

^Sipt bTt 3*7D5'-5' (x. y, z) 7)5t#e)n^o 

0. xi»Rr/yitft<75|=.I«nlJ:S«SlbTi^§o 
4f? [0060] x = xcos0v - ys in0v -xv 
y = xs In^v +ycos0v — yv 
z =— z V 

ffll 1 2, mm,%l 1 3, S[fli1Siifi?«S51 1 4, ISM'l 

&s^riRmaieB 1 1 5. ssftftWfiSi i eifeixy^^^^o. 

[0 0 6 1] [?gfaffi] «SiS6 1 1 3 \Z\t. m&^M'^ 
50 x-y^ffilC®»b, ^oyW-m^n-l^'i X(D^=f'Xm. 
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9 

i&*»TGa>(i. j) #B<©»T€:gi] t-rs- gij 
tt2'D(7)JKffi:7^^f t , fa SrffiitLTt'i^o 

[0 0 6 2] ft tt. M«7^i^-r*0. 
SBT&S75^S?&*i&Eaii''5. fa tt, iS^f^^^Tfe 

[0 0 6 3] f t ti, i&^gij7:)«5S^?5:^J^5T?&^3^^S 

[0 0 6 4] f a gU*<i1^lBfig*aT*^/j^5*^^gg 

^■r«»t)®-e*o> ii^S5S«T7iv^s-&«o-e*?), ^ 

[0 0 6 5] ft =2TS-pT> ^±?^^$lS<7)^^<h 
Ji. gijlC:^$li;$^^&^i:3g§S$n, ^^^r?. -r-<^giji^± 

[0 0 6 6] ft =lT»oT> ^l^^fSii^n-ViX^^m^ 

0<i:;^5o 

[0 0 6 7] [^l-l^iT^-^^/SgP] ^$Pir-3^^iS^fPl 
12ti, 3^*7CKtt^$SA*Sgl<tO'#e)n/c5g:^M^ 

^n^(i:>'f-i^ tmmi 1 3co7^-^^t&Mi'&-r 

So 

[0 0 6 8] iky. m S (cS':::^^.^Ti1^S[i7'-*^±;SfiB 1 ^ 

1 2(Dj!l?n:g:i5£l3)?rS« 

[0 0 6 9] mr^tLTftgijCO f t . f a ti. 

2|5:S»iEillI^IC*3ViTOtC*0«B^t;LX:te<. -^L/T, « 

[0 0 7 0] 3^7cKttl^ffiA:^gBl J; ' 

D?#^n;/^S 3^7C?"-5' (x, y, z) 

(x, y) (Dm^-^'^^iio^titkvytfii 

So 

[0 0 7 1] (X5^^yy2) fl =lT*^^gijlcM 

fa =lT*S?£ne»f t S:2i:TSo 40 
[0 0 7 2] OsJy^Z) ft =lT$>S&gij^!ii 
1 0tC^'rci:5iC8l%l«-C^^U>':i/b. "y^JVW&O^ 

[»1] 

11, 1 2 e L 
CDcfc "5 IC ^ ^^WrTft S tl S o 
[0 0 7 3] Ut-^^I/^) L/j<^*fr/j^5>0^^¥<J8frb 

[0 0 7 4] (Xt'-/:/5) Ld^Efi^S-TJ^V^tTJTf, L 5(? 



«fra¥7- 1 4 6 7 5 2 

tca^ns^^ji/M^T&^eeJcic 1 ^(om^ 1 i ^siR 
f'Sc -^bT, Bii uc^fipfc. *sea){aiap*> 

J i '\5H^^fc2*co}1l^p 1. P2{CHS 

^}K«6So ^:co^s«E$^^■r^^is■r'^TcOl^wtfr^giJ 

^ ] 1 <D^1.«i^tlA 1 > 1 2 <7>^1^fil*^«A 2 

[0 0 7 5] U5"ty:/6) ^1.®«A(C'&^nS g i j 

#«E-rsM*s*^^^nTi^'57&^s;&^&«SffbT. 

"/7fCiitl'o 

[0 0 7 6] iTsV'^y^fl) t^^i$.A\Z^^n^^\\<0 

^^i§EAi) . ^^;l/fiii«^lc^^nsgij^i^*BT^&S 
arbTft {C2S:ftAfSo 

[0 0 7 7] U7^^;;:/8) i1^®«^^A/TV:»S g i 
f a ^ 1 (hl^oc ^1 2C0fif^J-Cti. 1 llca^nSgij 

CO ft 2{cts^$nso Aitc-g-^nsgij 

00 fa tt, IfCSS^^nSo bA^b, A2(Dmmz\'ti 
t = lTSSgij;^^?^a:TS^^T. 12{r^^nSgiJ 
CO ft mco^^TSt), A2fC-g-^nSgii<^ f a 
0(7)^^T2>'&o 

[0 0 7 8] (X7^ry:/9) LtD^^/^^SaSib^'h^^ 

[0 0 7 9] L,f)^^m^t^O-(:. ft 

T^n ^;^ll2T*S^j&^1S?-gijrc^*b, -^c^gij;!?^ 
3*7CX~-:^C04'-cg;^<0 2 jas^fltzinax ^W^O^ 
(D^mJS^ "^bT^ i^ft^GfCzmax 2:f*JDb/JH'£#: 
d5^*&-7*V (lsdl3#!i«) ^f'^nfe-rSo 

[0 0 8 0] U5=-tyyii) m^Kti^^^K>n^ntz 

t&-j-<^WBia:f^£^<*?*G<7)mi-^ (O^l-^ z max ;ett± 
lc#«b;ttt4^ii:;&ffco«jiiiiOi-<hTfeD, Bli 3(Dit 

iSWI&^COW 13^3 V3k-C lis 1, S2. S3. 

[0 0 8 1] c^^yy^i 2) ei^±(7)ja3^^ff7^-p?^c 

n^y'-!^^^^! 1 2«. ^^^fflSBl 1 3(Dy=-i^ 

[00 8 2] i^mmmMmm nmmmmmm 114 
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u 

-ell. stassi 1 3<Din^amti^v(omm\zmu^n 
[0 0 8 3] mm&m'jj^Mam mm&m:ti\^»m 

[0 0 8 4] iXT-y-fl) i5W»^G(Cft =105*& 
[0 0 8 5] (XT-:y>^2) ,^^^T'G\Zfi =1(D^ 

[0 0 8 6] U5=-!y:/3) ifi^*ST-G<©^gijCD* 

ft =-2x$>^mm^sm^x^^Mmv^ 

[0 0 8 7] U^!y:/4) iffSLTVi^L 1. L 2 
UT^^^tfi, ^ 1 etc^-fck^t::. Hi, 12i©ffgtC 
[0 0 8 8] (7.y^y':fB) mi e\Z^'rJZ'0\Z. 1 2i 

tc^c*u 1 ii<Dm*b^ft'»b\zvt:iM*t^(oiiLS(omm\zm 

[0089] (X-r^y>^6) g^^^i|gB;^'JiS^T^;^c;^cC 

[0 0 9 0] (xv-y':f7) ig^mmmB^m^^^t. 
1 2 ^ ^ c5^iST-offiij lip (c^-r ^^[Mm 

m^^m7-i7 lt**^, 

[0 0 9 1] (7;7-';/y8) Jf^?gS«B4*T:*:Stft0a 

^e(^iif»i?fiic:igiKbfcK«<^iait»$:^fiE*r§ (^i8# 

[0 0 9 2] (X5-^/-/9) ^:cD{ii^4'i', gli9l;:^' 

[0 0 9 3] (7x5=-*v:/i 0) iiwrn^t^^rM^m 
mm'^r^tiy. como) (x, y, z) , ^ sr^^siiffiij^iii 

[0 0 9 41 (XT^-y:/!!) 1 liCOS»li«(^)±S87&5 



(7) i^Ba¥7- 1 4 6 7 5 2 

BiD-r^x (ommxss^mmcoi^is,^ ff^^^ iiicosj^ 
mm CD ± gp -7^ ^ X ^ •\' - ^ nr V ^ ^ s 

nri'ij^jifrj-ntfx^u/ :/8 icM^. 

[0 0 9 5] Uy^yZ^l 2) fl^^ffi^B (Dl-'^T©® 

^V-m^i-^^tl'Si^Jtt 1 litf^^tEVUl^m-^lZ 

[0 0 9 6] (X 5=- ty >^ 1 3 ) L 1 7^5^^'&7!i^S>0^^-PJ 

TOl 1 Q^m^Xtl^T^^. Ll7l)^^M^xm^n\£ 
2rg!bTV>-5 Hit 1 2icr)ffi*SrXnl:bTBE^SS«c*» 
7N'T--y':/4lcM'So 
[0 0 9 7] t^KWiBgR] ^SftMWSBi i exttSfflS 
ffie*|n)^mS5l 1 5<kOA:/J^n^ttS (x, y, 

1 1 i^mm-r^o ^br. ^mi^rcWi. s^kTim^m 

ffi«l?^JCfett^Sa:tt:a*rRltbT. (x, y, z) . 
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